Sensor Fusion for Kinetis MCUs (ISSDK/KSDK version)
main_baremetal.c File Reference
+ Include dependency graph for main_baremetal.c:

Go to the source code of this file.

Functions

int main (void)
 

Variables

SensorFusionGlobals sfg
 
ControlSubsystem controlSubsystem
 
StatusSubsystem statusSubsystem
 
PhysicalSensor sensors [3]
 

Detailed Description

This file shows the recommended way to incorporate sensor fusion capabilities into a bare metal (no RTOS) project.

Definition in file main_baremetal.c.

Function Documentation

int main ( void  )

This is a bare-metal implementation of the NXP sensor fusion demo build.

Definition at line 65 of file main_baremetal.c.

66 {
67  ARM_DRIVER_I2C* I2Cdrv = &I2C_S_DRIVER_BLOCKING; // defined in the <shield>.h file
68  uint16_t i=0; // general counter variable
69  BOARD_InitPins(); // defined in pin_mux.c, initializes pkg pins
70  BOARD_BootClockRUN(); // defined in clock_config.c, initializes clocks
71  BOARD_InitDebugConsole(); // defined in board.c, initializes the OpenSDA port
72  I2Cdrv->Initialize(NULL); // Initialize the KSDK driver for the I2C port
73 
74  I2Cdrv->Control(ARM_I2C_BUS_SPEED, ARM_I2C_BUS_SPEED_FAST); // Configure the I2C bus speed
75 
76  initializeControlPort(&controlSubsystem); // configure pins and ports for the control sub-system
77  initializeStatusSubsystem(&statusSubsystem); // configure pins and ports for the status sub-system
78  initSensorFusionGlobals(&sfg, &statusSubsystem, &controlSubsystem); // Initialize sensor fusion structures
79  // "install" the sensors we will be using
80 #if F_USING_ACCEL || F_USING_MAG
81  sfg.installSensor(&sfg, &sensors[0], FXOS8700_I2C_ADDR, 1, (void*) I2Cdrv, FXOS8700_Init, FXOS8700_Read);
82 #endif
83 #if F_USING_GYRO
84  sfg.installSensor(&sfg, &sensors[1], FXAS21002_I2C_ADDR, 1, (void*) I2Cdrv, FXAS21002_Init, FXAS21002_Read);
85 #endif
86 #if F_USING_PRESSURE
87  sfg.installSensor(&sfg, &sensors[2], MPL3115_I2C_ADDR, 1, (void*) I2Cdrv, MPL3115_Init, MPL3115_Read);
88 #endif
89  sfg.initializeFusionEngine(&sfg); // This will initialize sensors and magnetic calibration
90 
91  pit_init(1000000/FUSION_HZ); // pitIsrFlag will be set true at FUSION_HZ periodic intervals
92 
93  sfg.setStatus(&sfg, NORMAL); // If we got this far, let's set status state to NORMAL
94  while (true)
95  {
96  if (true == pitIsrFlag) { // Check whether occur interupt and toggle LED
97  sfg.readSensors(&sfg, 1); // Reads sensors, applies HAL and does averaging (if applicable)
98  sfg.conditionSensorReadings(&sfg); // magCal is run as part of this
99  sfg.runFusion(&sfg); // Run the actual fusion algorithms
100  sfg.applyPerturbation(&sfg); // apply debug perturbation (testing only)
101  sfg.loopcounter++; // The loop counter is used to "serialize" mag cal operations
102  i=i+1;
103  if (i>=4) { // Some status codes include a "blink" feature. This loop
104  i=0; // should cycle at least four times for that to operate correctly.
105  sfg.updateStatus(&sfg); // This is where pending status updates are made visible
106  }
107 
108  sfg.queueStatus(&sfg, NORMAL); // assume NORMAL status for next pass through the loop
109  sfg.pControlSubsystem->stream(&sfg, sUARTOutputBuffer); // Send stream data to the Sensor Fusion Toolbox
110  pitIsrFlag = false; // Reset the flag for the next cycle
111  }
112  }
113 }
void initSensorFusionGlobals(SensorFusionGlobals *sfg, StatusSubsystem *pStatusSubsystem, ControlSubsystem *pControlSubsystem)
utility function to insert default values in the top level structure
Definition: sensor_fusion.c:68
int32_t loopcounter
counter incrementing each iteration of sensor fusion (typically 25Hz)
conditionSensorReadings_t * conditionSensorReadings
preprocessing step for sensor fusion
int8_t FXOS8700_Read(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
void initializeStatusSubsystem(StatusSubsystem *pStatus)
initializeStatusSubsystem() should be called once at startup to initialize the data structure and to ...
Definition: status.c:185
PhysicalSensor sensors[3]
This implementation uses up to 3 sensors.
streamData_t * stream
function to create packets for serial stream
Definition: control.h:73
installSensor_t * installSensor
function for installing a new sensor into t
ControlSubsystem controlSubsystem
used for serial communications
void pit_init(uint32_t microseconds)
Definition: driver_pit.c:62
readSensors_t * readSensors
read all physical sensors
struct ControlSubsystem * pControlSubsystem
initializeFusionEngine_t * initializeFusionEngine
set sensor fusion structures to initial values
int8_t MPL3115_Init(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
updateStatus_t * updateStatus
status=next status
int8_t FXOS8700_Init(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
volatile bool pitIsrFlag
Definition: driver_pit.c:53
int8_t FXAS21002_Read(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
int8_t MPL3115_Read(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
uint8_t sUARTOutputBuffer[256]
main output buffer defined in control.c
Definition: control.c:59
int8_t initializeControlPort(ControlSubsystem *pComm)
Initialize the control subsystem and all related hardware.
Definition: control.c:182
runFusion_t * runFusion
run the fusion routines
ARM_DRIVER_I2C * I2Cdrv
KSDK handle for the I2C port defined in Driver_I2C_KSDK2.c.
SensorFusionGlobals sfg
This is the primary sensor fusion data structure.
setStatus_t * queueStatus
queue status change for next regular interval
#define FUSION_HZ
(int) actual rate of fusion algorithm execution and sensor FIFO reads
StatusSubsystem statusSubsystem
provides visual (usually LED) status indicator
setStatus_t * setStatus
change status indicator immediately
applyPerturbation_t * applyPerturbation
apply step function for testing purposes
int8_t FXAS21002_Init(PhysicalSensor *sensor, SensorFusionGlobals *sfg)
Operation is Nominal.

+ Here is the call graph for this function:

Variable Documentation

ControlSubsystem controlSubsystem

used for serial communications

Definition at line 60 of file main_baremetal.c.

PhysicalSensor sensors[3]

This implementation uses up to 3 sensors.

Definition at line 62 of file main_baremetal.c.

This is the primary sensor fusion data structure.

Definition at line 59 of file main_baremetal.c.

StatusSubsystem statusSubsystem

provides visual (usually LED) status indicator

Definition at line 61 of file main_baremetal.c.